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(54) Robot controller 
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(57) Axes used tor posture alignment are selected 
from the axes of a work coordinate system W and a tool 
coordinate system T and an angle of Intersection be- 
tween those selected axes are set. A robot is then driven 
so that the selected axes intersect with each other by 
the set angle of intersection in response to a posture 
alignment instruction, causing the tool to assume a tar- 
get posture with respect to a workplece. Further, angles 
for rotating the work coordinate system about each axis 
thereof are set, then the robot is automatically moved 
so that a coordinate system produced by rotating the 
work coordinate system by the set angle in response to 
a posture alignment instruction. Further, the tool coordi- 
nate system set at a movable part of a tool is automat- 
ically reset according to an anrraunt of movement every 
time the movable part of the tool move, and the robot is 
manually fed based on the tool coordinate system thus 
reset. 
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Description 

[0001] The present invention relates to a robot controller for making teaching work easier 

[0002] One method of teaching a robot is direct teaching where a robot is manually operated so as to be taught each 
5 teaching point. In this method, an operator selectively teaches the teaching points while monitoring the positional 
relationship of tools attached to the wrist of the robot and the workpiece. 

[0003] However, when, for example, a position at the lower part of the body of a vehicle is to be taught as a position 
for spot welding, it is probable that this positbn to be taught cannot be seen. Conventionally, with teaching of places 
where the positional relationship between the robot tools and the workpiece is difficult to discem, teaching of such 
10 teaching points has relied upon the intuition of the operator. When teaching a contact position of a tool and a workpiece, 
the contact conditions are discemed by the operator. When a location is difficult to see. methods as described above 
where teaching is carried out relying upon the intuition of the operator or where the operate teaches while looking with 
a lamp to be aware of contact between tools and a workpiece are also put into practice. 

[0004] In cases where a position is taught where a robot (tool) should be moved in a fixed direction by a fixed amount 
^5 from a current position, conventionally a method has been adopted where a manual operation is carried out while the 
operator confirms the current position of the robot (tool), the robot (tool) is moved up to the teaching position, the 
desired distance of operation is added to the current position and the teaching position is directly obtained- 
[0005] There are also cases where it is preferable to change the position or posture of a tool by performing a nr^nual 
feed operation to the position where the tool Is to be moved, taking the tool center point as a reference. In this case, 
20 conventionally, the tool coordinate system is reset every time the position where the tool center point is set is moved. 
Further, when a teaching point is taught where a tool is brought into contact with or brought close to the workpiece In 
a fixed posture, the operator operates the tool until the desired posture is obtained using a manual feeding. 
[0006] However, relying on the intuition of the operator for teaching positions that are difficult to see invites inaccuracy 
in the teaching positions and teaching work therefore becomes difficult. Further, in the case of teaching a position of 
25 contact of the workpiece and the tool, variations in teaching position occur and reliable teaching work Is difficult when 
teaching relies upon the intuition of the operator or when the operator carries out teaching while monitoring the contact 
position of a workpiece and a tool using a lamp. 

[0007] In the case of operations of a fixed amount in a fixed direction from a current position, with methods where a 
teaching position is obtained from manual feeding by the operator or by adding to a current position a distance to be 
30 moved, variations in the teaching position occur and teaching work becomes complex. Further, resetting a tool coor- 
dinate system every time the tool center point moves when changing the tool posture taking the tool center point as a 
reference, or obtaining a posture of the tool through manual operation when bringing a tool into contact with or close 
to a workpiece in a fixed posture also makes teaching work complicated. 

[0008] It is an object of the present Invention to provide a robot controller that can assist a teaching operation and 

35 where teaching is straightforward. 

[0009] The robot controller according to the present invention automatically attains a target position, upon inputting 
a manual posture alignment instruction, an axis being selectively set for a set tool coordinate system and an axis being 
selectively set for a work coordinate system which axes intersect with each other by a set angle or to be parallel with 
each other, based upon set data on the intersecting angle or relationship of those axes. Then the roix)t is manually 

40 controlled to move to the target position. These procedures make teaching work easy. 
> [0010]. Thus, in one aspect, this Inventbn provides. . 

a robot controller comprising: 

storage means for storing a tool coordinate system set to the position and posture of a tool attached to a robot, a 
45 work coordinate system set to the environment where a workpiece Is placed, any one coordinate axis selected 

from the three coordinate axes of the tool coordinate system and any one coordinate axis selected from the three 
coordinate axes of the work coordinate system used In carrying out posture alignment, and an angle of intersection 
formed between said two selected coordinate axes; 

means for obtaining a target posture of the robot in a such manner that the angle formed between the two selected 
so coordinate axes becomes equal to the stored angle when a posture alignment Instruction is inputted; and 

means for automatically moving the robot to the target posture. 

[0011] In a second aspect, the Invention provides 

55 aj-obot controller comprising; 

storage means for storing a tool coordinate system set to the position and posture of a tool attached to a robot, a 

work coordinate system set to the environment where a workpiece is placed, and data specifying a posture rela- 
tionship of the tool coordinate system and the work coordinate system used in carrying out posture alignment; 
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means for obtaining a target posture of the robot in such a manner that the tool coordinate system and the work 
coordinate system take on the posture relationship indicated by the specified data stored in the storage means 
when a posture alignment instruction is inputted; and 
means for automatically moving the robot to the target posture.. 

5 

[0012] Teaching work is also made easier by automatically obtaining a target position where a relationship set for 
the tool coordinate system and the work coordinate system is fulfilled using a manual alignment instruction and by 
manually feeding the robot to the target position. 

[001 3] When a tool having moving parts is attached to a wrist at the end of a robot anm and a reference tool coordinate 
10 system is set for the moving parts, the reference tool coordinate system is transformed based on the amount of move- 
ment of the moving parts of the tool and the tool coordinate system is lined up with the movement of the moving parts 
of the tool. This also makes teaching work easier 
[0014] Thus, in a third aspect, this invention provides 

'5 a robot controller, with a tool having moving parts attached to a robot and with a tool coordinate system set to a 

reference position and posture on the moving parts, said robot controller comprising: 

means for transforming the tool coordinate system based on an amount of movement of the moving parts of the 
tool from the reference position and posture, 

wherein the tool coordinate system is made to move In line with movement of the moving parts of the tool from the 
20 reference position and posture. 

[0015] When manual feeding suspension conditions are preset at the robot controller and a monitoring means detects 
that the suspension conditions have been fulfilled during the manual feeding, the manual feeding is automatically 
suspended. This also makes teaching work easier. 
2S [0016] Thus, in a fourth aspect, the invention provides 

a robot controller comprising: 

monitoring means for monitoring whether or not a nnanual operation suspension condition set in advance in the 
robot controller is fulfilled, said manual operation suspension condition being fulfilled when a sense signal from a 

30 - sensor for sensing contact of a tool attached to a robot and a workpiece is outputted, when a load torque on one 
or more motor of motors driving each axis of the robot exceeds a set torque, or when a predetermined distance is 
rnoved from a manual operation start position. 

wherein the manual operation is automatically interrupted when fulfillment of the suspension conditions is detected 
from the monitoring means during a manual feeding. 

35 

[0017] The foregoing and other objects and features of the invention will become apparent from the following de- 
scription of the preferred embodiments of the invention with reference to the accompanying drawings, in which; 

FIG. 1 Is a block diagram of the essential parts of a irobot controller according to the present invention; 
40 FIG. 2 is a view illustrating the teaching pendant of the robot controller of FIG. 1 ; 

- FIG. 3 is a flowchart which shows a posture alignment performed by the first embodiment of the present invention; 

FIG. 4(a)-4(g) are views illustrating actions done by the first embodiment; 

FIG. 5 Is a flowchart which shows a posture alignment done by a second embodiment of the present invention; 
FIG. 6(a)-6(c) are views illustrating the actions done by the second embodiment; 
^ FIG. 7 is a flowchart which shows a tool coordinate system resetting process performed by a third embodiment of 

the present invention; 

FIG. 8(a)-8{c') and FIG. 9(a)-9(c') are views illustrating actions done by the third embodiment; 
FIG. 1 0 is a flowchart which shows a process for automatically suspending a manual feeding performed by a fourth 
embodiment of the present invention; 
so FIG. 1 1 (a)-1 1 (d) are views illustrating the application of each embodiment of the present invention to a servo gun 

for carrying out spot welding; 

FIG. 1 2 is a view illustrating an operation for making retreat after a tool makes contact with a workpiece when each 
embodiment of the present invention is applied to an air gun for carrying out spot welding; and 
FIG. 1 3(a}-1 3(c) are views illustrating the operation when each embodiment of the present inventk>n is applied to 
55 a hand'with.moving parts driven by a servo system. 
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DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

[0018] FIG. 1 Is a block diagram of the essential parts of a robot controller of the first embodiment of the present 
invention, having the same configuration as a prior art robot controller. A main processor (hereinafter referred to simply 
as "processor") 101. a memory 102 comprising RAM, ROM and non-volatile memory (EEPROM etc.), a teaching 
pendant interface 103, an Input/output interface 106 for use with external devices and a servo control unit 105 are 
connected to a bus 107. A teaching pendant 104 is connected to the teaching pendant interface 103. 
[0019] A system program supporting the basic functions of the robot and the robot controller is stored in the ROM 
of the memory 102. Programs for operating the robot to be taught in response to applications and related set data are 
stored in the non-volatile memory of the memory 102. The RAM of the memory 102.1s used as a storage region for 
temporarily storing data occurring in various arithmetic processing carried out by the processor 101. 
[0020] The servo control unit 105 is equipped with servo controllers #1, #2, ..... #n (where n is a number given by 
adding a number of movable axes of the tool to the total number of axes of the robot), receives movement instructions 
for controlling the robot resulting from arithmetic processing (orbit plan production and interpolation and inverse trans- 
formations etc. based on this orbit plan production), and controls servo motors comprising actuators for each of the 
axial mechanisms of the robot via servo amplifiers. 

[0021] Sensors provided at the robot and sensors and actuators for peripheral devices are connected to external 
input/output circuits of an input/output interface 1 06, with sensors for detecting contact between tools and the workpiece 
being connected in particular In the case of the present invention. 

[0022] The configuration for the robot controller described above does not differ from a prior art robot controller. The 
present invention/however, differs from the prior art in that a posture alignment key is provided at the teaching pendant 
104 and in that control or the like of the posture and position of a tool is executed automatically in order to provide 
teaching assistance. 

[0023] FIG. 2 is a view illustrating an example of a teaching pendant 104 according to the present invention. This 
teaching pendant 104 differs from a prior art teaching pendant in that a posture alignment key 19 is provided and a 
mode for teaching assistance (to be described later) can be selected using a soft key 11, with other aspect being the 

same as for the prior art. 

[0024] FIG. 2 shows just the portion relating to the present invention, with other portions being omitted, i.e. as in the 
related art. The teaching pendant 104 of FIG.2 has a display 10 comprising an LCD etc.. the soft key 11 for selecting 
a mode for teaching assistance according to the present invention, a liner movement key 12 for giving instructions to 
move in + and - directions along axes X, Y and 2 of an orthogonal coordinate system selected from coordinate systems 
(a robot reference coordinate system, a work coordinate system set relative from the reference coordinate system, 
and a tool coordinate system) selected by a key 16 for selecting a coordinate system, rotation operation keys 13 for 
giving instructions to rotate in + and - directions about the axes X, Y and Z, and axis operation keys 14 for instructing 
operations of the robot in + and - directions of each of the joint axes J1 to J6. The teaching pendant 104 shown In FIG. 
2 is for 6-axis robot. 

[0025] Further, the teaching pendant 104 is. as in the prior art. also equipped with a shift key 15, to be pushed 
together with each of the operation keys 12. 13 and 14, for inputting related instructions, a key 16 for selecting a 
coordinate system, a mode key 17 for switching between teaching mode and playback mode, and a function selection 
key 18 for selecting setting display screens for the various coordinate system settings and parameter settings etc. to 
enable settings to be made. 

[0026] In reality, the teaching pendant 104 is also provided with keys such as various instruction keys which a prior 
art teaching pendant would have, in addition to those described above, but FIG. 2 only shows key portions directly 
relating to the present invention. 

[0027] An operator carries out, through manual operation using the teaching pendant 104, playing back of a taught 
operation program, jog-feeding and the like, in addition to teaching of a rotx)t operatk^n programs, modification and 
registration of the program and setting of various parameters, in the same manner as in the prior art. The display can 
also be used to give instructions to the operator, display input data and display simulation results. 

[First Embodiment] 

[0028] The first embodiment automatically alters tool posture in such a manner that the relationship between a tool 
attached to a wrist at the end of an robot arm and the workpiece is the desired relationship. 

[0029] Specifically, the first embodiment automatically alters tool posture in such a manner that one axis is selected 
from each of a work coocdinate system .\Atset.ior.the workpiece relative to the jobot reference coocdinate syslem.aad-. 
.a tool coordinate system, T set wrth respect to. the tool and a.relatioriship (angle of Intersection) set for these axes is 
attained. As described later in FIG. 11(c), this is applicable to cases of setting the posture of a spot welding gun in 
such a manner that the tip of the spot welding gun (toot) and the surface of the position of a workpiece to be welded 
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become perpendicular with respect to each other. 

[0030] The operation of this first embodinnent is described referring to FIG. 3 showing processing of the nnain proc- 
essor 101 of the robot controller and FIGS. 4(a) to 4(g) illustrating operation according to the embodiment. FIGS. 4(a) 
to FIG. 4(g) show an example employing a spot welding gun as a tool 

s [0031] First, the function selection key 18 is operated in advance, and, as shown in FIG. 4(a). a tool coordinate 
system T and a work coordinate system W are set in the same manner as in the case of the prior art. 
[0032] According to this embodiment, posture alignment is carried out in such a manner that one axis selected for 
the work coordinate system W and one axis selected for the tool coordinate system T intersect with each other by a 
set angle. To this end, one axis of the axes X, Y and Z o1 the tool coordinate system T and one axis of the axes X, Y 

10 and Z ot the work coordinate system are selectively set in order to carry out posture alignment and an angle of inter- 
section between the selectively set axes is set. 

[0033] In the example shown in FIG. 4(a)-4(g), the Z axis is selected for both the tool coordinate system T and the 
work coordinate system W and an angle of intersection of 6 is set. If the angle of intersection set is 0. this means that 
the selected axes face in the same direction. The operating speed for manual feeding Is also set beforehand in order 
to perform posture alignment. 

[0034] The operator, after operating the mode key 1 7, operates the robot so that the 21 moves to the position where 
it Is to be taught with respect to the workpiece 21 . Then the operator depresses the sift key 1 Sand the posture alignment 
key 19 for carrying out posture alignment, so that the processor 101 starts the process of FIG. 3. 
[0035] A unit vector t (refer to FIG. 4(b)) passing through the origin of the tool coordinate system T in parallel with 
20 the axis (axis Z in the case of FIGS! 4(a) to 4(g)) selectively set for the tool coordinate system T is obtained (step a1). 
[0036] Next, a unit vector w (refer to FIG. 4(c)) passing through the origin of the tool coordinate system T in parallel 
with the axis (axis Z in the case of FIGS. 4(a) to 4(g)) selectively set for the work coordinate system W (step a2) is 
obtained. 

[0037] A nornr^al vector n passing through the origin of the tool coordinate system T and being orthogonal to the 
2S vectors t and w is then obtained from the vector product of the unit vector t and the unit vector w (refer to FIG. 4(d)) 
(step aS). 

n = t X w 

(where x is the operator of the vector product) 

[0038] It is then determined as to whether or not the normal vector n obtained is "0" (step a4). If the normal vector 
n Is "p" , step a8 is proceeded to. 

[003Sg On the other hand, if the norma! vector n Is "0" , this means that the unit vectors t and w are parallel so that 
a de^^lte normal vector cannot be obtained from these vectors. An alarm is then generated at the display etc. of the 
teaching pendant 104 and a message is displayed (step a5) inviting the input of a vector n' passing through the origin 
of the tool coordinate system T in a plane formed by two axes different from those set for the tool coordinate system. 
In the example shown In FIGS. 4(a) to 4(g), the axis Z of the tool coordinate system T is set as the selected axis and 
in this case inputting of a vector n' passing through the origin of the tool coordinate system in the XY plane of the tool 
coordinate system T is invited, but, in practice, for obtaining such a vector n' , it is sufficient that the X axis or the Y 
axis be designated. In the example in FIG. 4(e) the X axis is designated. 

[0040] When the vector n' is inputted (step a6), the vector n' is taken as the normal vector (step a7) and step aS Is 
proceeded to. In step aB, the angle of intersection a of the vectors t and w is derived (refer to FIG. 4(e))- 
[0041] A transformation matrix F is then obtained by rotating the normal vector n by a difference (a - B) of the obtained 
angle of intersection a and the target set angle of intersection 8 (step a9). When the set target angle of intersection is 
"O" , the difference isa-e = a- 0 = a and a transformation matrix F where the vector t coincides with the vector w (in 
the example of FIGS. 4(a) to 4(g), the axis z of the tool coordinate system T and the axis Z of the work coordinate 
system W are parallel) is obtained. 

[0042] A coordinate system R for a flanged surface of the wrist at the end of an arm of the robot in a current robot 
posture and position, viewed from the robot reference coordinate system, is then obtained. And also a coordinate 
system H for the end of the tool, viewed from the robot reference coordinate system, is obtained from the coordinate 
system R and the tool coordinate system T (step alO). 

•*H = R*T 

[0043] The above transformation matrix is then applied to the above obtained coordinate system H and a coordinate 
system H' for a target posture and position for the tool posture alignment is obtained (step all ) (refer to FIG. 4(f)). 
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H' = H«F 

[0044] The robot is then driven in such a nnanner as to operate at the set operating speed towards the target posture 
position H* (step a1 2). In FIG. 4(g), tool posture H before posture alignnnent is shown by dotted lines and tool posture 
H' after posture alignment (when the set target angle G = 0) is shown by solid lines. 

[0045] The robot is then driven automatically in such a manner that the axis selected for the tool coordinate system 
T satisfies a prescribed relationship (set angle of intersection 9) with respect to the axis selected tor the work coordinate 
system W and the posture of the tool 20 then satisfies the desired relationship with respect to the workpiece 21 . 

[Second Embodiment] 



[0046] In the first embodiment, a robot is automatically driven and the posture of the tool 20 is changed so that the 
axis selected for the tool coordinate system T and the axis selected for the work coordinate system W satisfy a pre- 
is determined relationship (that is, intersect with each other by a set angle). In contrast with this, in the second embodi- 
ment, the tool posture is changed by automatically driving a robot in such a matter that the tool coordinate system T 
satisfies a set relative relationship with respect to the work coordinate system W. 

[0047] First, the tool coordinate system T and the work coordinate system W are set in the same manner as in the 
case of the first emlx)diment. The operation speed tor manual feeding during posture alignment is also set. The relative 

20 relationship it is wished to establish between the work coordinate system W and the tool coordinate system T is also set. 
[0048] Rotation angles for rotation about the axes X, Y and Z of the work coordinate system are set when it is wished 
to make a rotated work coordinate system the target posture for the tool coordinate system T The process of FIG. 5 
is then executed by the main processor 101 by continuous simultaneous pressing of the shift key IS.and the posture 
alignmerit key 19 of the teaching pendant 104 and the tool posture is automatically changed to the target posture. 

2S [0049] FIGS. 6(a) to 6(c) are views illustrating the operation of this second embodiment, with FIG. 6(a) showing the 
relationship between the workpiece (work coordinate system) before carrying out posture alignment and the tool (tool 
coordinate system). 

[0050] When the shift key 1 5 and the posture alignment key 1 9 are pressed at the same time, a transformation matrix 
F for rotating the work coordinate system W by just the set rotation angles is obtained based on the rotation angles 
30 about the axes of rotation X, Y and Z set for the work coordinate system W (step b1). The transformation matrix F is 
then applied to with the work coordinate system W to obtain a work coordinate system G after the transformation is 
obtained (step b2) (refer to FIG. 6(b)). 

35 G = W.F 

[0051] Next, a coordinate system R for a flanged surface of the wrist at the end of an arm of the robot in a current 
robot posture and position, viewed from the robot reference coordinate system, is obtained and a coordinate system 
H for the end of the tool viewed from the robot reference coordinate system is obtained from the coordinate system R 
40 and the tool coordinate system T (step b3). 

H = R«T 

45 [0052] The coordinate systems G and H thus obtained are then resolved into posture components Gr and Hr, and 

position components Gl and HI, the posture component Hr of the coordinate system H is substituted with the posture 
component Gr of the coordinate system G, and a new coordinate system H' for the coordinate system for the end of 
the tool is obtained (step b4) (refer to FIG. 6(c)). 

[0053] Namely, the coordinate system G and the cooi-dinate system H are expressed by the following equations 1 
so and 2. 
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[0054] The new coordinate system H' obtained by replacing the posture component Hr of the coordinate system H 
with the posture component Gr of the coordinate system G is expressed by the following equation 3. 
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[0055] The robot is driven at the set operating speed in the direction of the new coordinate system H' obtained from 
equation 3 and the tool posture is changed in such a nnanner that the tool coordinate system satisfies the relative 
relationship set with respect to the work coordinate system and the posture alignment operation is completed (step b5). 

[Third Embodiment] 



[0056] I n the third emt)odiment. the invention is applied to the case where a servo gun capable of sensing the position 

of movable parts of tools and driven by a servo motor is utilized as the tool 20. In this embodiment the movable parts 
40 of the tool 20 are put under servo control as an additional axis of the robot controller and control of the movable parts 
- - is also carried out by the robot controller. A key can also be provided on the teaching pendant 104 as manual operating 

means for manually feeding the moving parts of the tool» but in the example shown in FIG. 2 such a key is not provided. 

[0057] When it is more convenient to rotate and move the tool on the basis of a tool center point (hereinafter referred 

to as "TCP" ) the tool coordinate system T is set for the tool 20, and when a part where TCP is set moves, the tool 
45 coordinate system T is automatically set in accordance with the movement of the TCP. 

[0058] A process executed by the main processor 101 of the robot controller is explained using a flowchart of FIG. 

7 and FIGS. 8(a) to 8(c') and FIGS. 9(a) to 9(c*) illustrating operations of the tool. 

[0059] First, a tool coordinate system T taken as a reference is set at a part of the tool 20. FIG. 6(a) shows a case 
where the tool coordinate system T is set at a movable part 20a of the tool 20 (specifically, set at the tip of a movable 
so aide of a spot welding gun) and FIG. 8(a' ) shows a case where the tool coordinate system T is set at a fixed part 20b 
of the too! 20. 

[0060] FIGS. 8(a) to 8(c) and FIGS. 9(a) to 9(c) show the case where the tool coordinate system T is set at the 

movable part 20a of the iddl 20, while FIGS. 8(a*) to 8(c') and FIGS. 9(a') to 9(c*) show the case where the tool coordinate 

system T is set at a fixed part 20b of the tool 20, 
55 [0061]_ Mext, a reference position 0 of the movable part is set on the looL coordinate systemset in the above manner 
. _ . _ In FIG. B(b) and, FIG. 8(b'), this refererice position 0 is set to a place where it is apart from the position B of a fixed part 

on the side on which the tip of the movable part is provided, by a distance "O" in the direction of movable part. 

[0062] The direction of shifting of the nnovable part 20a of the tool 20 is set on the basis of the axis X, Y or Z of the 
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tool coordinate system T. In the exannpies in FIG. 8(c) and FIG. 8(c'), the Z axis of the too! coordinate system 2 is set. 
[0063] Further, the movable part (tip on movable side) 20a of the tool 20 is moved to the desired position P by manual 
feeding or by execution of a program (refer to FIG. 9(a) and FIG. 9(a' )) after setting of the operating speed in manual 
feeding. 

5 [0064] When the shift key 1 5 and the operating direction key 12 are then pressed and a manual feeding is instructed 
based on the tool coordinate system T, the main processor 101 of the robot controller starts the processing ot FIG. 7. 
[0065] First, a distance L (L = P - O) from the reference position 0 set for the too! moving part 20a to the current 
position P of the tool moving part 20a is obtained (step cl) (refer to FIG. 9(b) and FIG. 9(b* )) and the transformation 
matrix F is obtained (step c2) as a translation matrix for the obtained distance L in the direction of the axis (in this 

10 example, the direction of the Z axis) set for the direction of movement. 

[0066] A new tool coordinate system T' is obtained from the set tool coordinate system T as the reference coordinate 
system and the above-mentioned transfomnation matrix F from the following equation (step c3) (refer to FIG. 9(c) and 
FIG. 9(c' )). 



75 

r=T*F 

[0067] And a PDanual feeding in the direction of the axis instructed based on the newly obtained tool coordinate 
system T' is then executed (step c4). 
20 [0068] According to this embodiment, as shown in FIG. 9(b) and FIG. 9(b' ), and FIG. 9(c) and FIG. 9(c' ), even if 
the moving part 20a of the tool 20 moves, the tool coordinate system T after the movement can be obtained automatically 
and the movement takes place in the instructed direction of operation based on the obtained tool coordinate system 
T . so that the tool 20 and the workpiece 21 are therefore prevented from interfering with each other during the move- 
ment. 

2B 

[Fourth Embodiment] 



[0069] in the fourth embodiment, operation of the robot is automatically suspended when certain suspension condi- 
tions that are set up are fulfilled when the robot is being moved by manual operation. The conditions for suspension 
30 therefore have to be set in advance in this embodiment. The suspension conditions are. deemed fulfilled in the following 
cases, for example; 

(1) A sensor for sensing the. fact that the tool comes into contact with the workpiece is provided and an output 
signal from the sensor is detected via the input/output interface 106. 
35 (2) The load torque of servo motors driving each axis ot the robot is detected, and if a threshold value is exceeded 

by the load torque of any one of the sen^o motors, it is deemed that the tool 20 has come into contact v/;^" Th-r 
workpiece 21. 

In practice, the load torque is detected based on the feedback values of the drive currents for the serve- rnovcHv 
for each axis or based on the torque command values (current instruction values), and it Is deemed that the sus- 
40 pension conditions is fulfilled when the detected load torque (or detected current) or the torque command value 

- are equal to or greater than set threshold values, . 

Further, when an observer for estimating load torque is provided, the suspension conditions can be arranged 
In such a manner that operation is suspended when the load torque estimated by the observer is equal to or in 
excess ot the threshold value. 

45 (3) A manual operation is automatically suspended when the distance moved from the manual operation start point 

exceeds a set value. 

[0070] There are various kinds of suspension conditions and optimum suspension coridition is selected in accof ; >" . c 
with an application. For example, if the suspension conditions (1) to (3) are applicable to the robot controller, whj;:!"; 
so these conditions should be selected as the suspension condition can be set beforehand. It is necessary to set a distance 
to be moved from the start point for automatic suspension as a set value in the case where the suspension condition 

(3) is selected. 

[0071] After the operating speed during manual operation is set and the conditions for suspension arafulfilled, wheth- 
er or not to operate by a designated amount in a designated direction from the suspension position is set. When this 

55 is set, the coordinataaystem (robot reference coordinate system, work.coordinate system, tooLcoordinate system etcj. 

. . taken as a reference for the c^eraling directiori is selectively set. one of the axes X, Y or Z of this selected coordinate 

system is set as the operating direction and the distance to be moved is also set. 

[0072] After setting of the suspension conditions, the operating speed, as to whether or not to retreat after fulfillment 
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of the suspension conditions, and as to in which direction and by how much amount of movement to retreat in case of 
retreating, the shift key 15 and the operation direction keys 12 and 13 are pushed so as to instruct a manual feeding, 
the main processor 101 of the robot controller starts the process of FIG. 10. 

[0073] The main processor 101 outputs move instruction to move the robot in an operating direction instructed by 
5 the operation direction keys 1 2 and 1 3 at the set operating speed so that the robot is made to move at the set operating 
speed (step d1). Whether or riot the suspension conditions are fulfilled is then determined (step d2). If not fulfilled, 
whether or not depression of the operation direction keys have been released is determined (step d8). If not released, 
then process return to step d1 and the process of step d1 , step d2 and step d8 is repeated. 

[0074] If the depression of the shift key 1 5 or the operation direction keys 12 and 13 are released before fulfillment 

10 of the suspension condition Is sensed, operation of the robot is suspended (step d7). 

[0075] When the condition for suspension is fulfilled, for example, if the suspension condition (1) above has been 
set, the main processor 101 detects whether or not a contact detection signal from the sensor is inputted to the input/ 
output interface 1 06 with every predetemnined period. When the main processor 101 detects input of a contact detection 
signal, the position at this time is stored arid the manual feeding for the robot is automatically suspended (regardless 

IS of whether or not the shift key 1 5 and the operation direction keys 1 2 and 1 3 are pushed) (step d2, step d3). 

[0076] In the case where the condition (2) above is set, the main processor 101 determines, with every predetermined 
period, whether or not the load torque (current feedback value, torque instruction value, or torque value estimated by 
an observer) on the motors for each axis of the robot is equal to or greater than a threshold value (step d2). The position 
at the time when the load torque of a motor tor any one of the axes is greater than or equal to the threshold value Is 

20 then stored and operation of the robot Is suspended (step d3). 

[0077] In the case where the suspension condition (3) above is set, the main processor 101 adds the movement 
amount of the robot to a register after the start of manual operation at step d1 with every predetermined period and 
determines whether the suspension condition is fulfilled or not by determining whether or not this added value has 
become the set value. When this added value is equal to or greater than the set value, it is assumed that the suspension 

25 condition is fulfilled (step d2), so that position of the robot at this time is then stored and movement of the robot is 
suspended (step d3). 

[0078] When an instruction to suspend movement of the robot Is outputted by the robot controller, the robot over- 
shoots -because of its own momentum. The robot is therefore returned to the position where the stored suspension 
condition is fulfilled (step d4). A determination is then made as to whether or not a retreat of the robot has been set 
30 (stepi'dS). If a retreat has been set, movement is carried out In the set direction by the set amount (step d6) and 
movement of the robot Is suspended (step d7); If a retreat has not been set, on the other hand, the robot is left stopped 
at the position where the robot was stopped according to the suspension condition. 

[0079] The above, explanations Is concemed with embodiments for a manual feeding assisting in a teaching oper- 
ationaof the present invention. However, any one of the first to fourth enribodiments stated above can be provided in a 
3S robottcontroller and executed or all of the first to fourth embodiments can be provided and then called up for execution 
using a soft key etc. 

[0080] In the following embodiment, the first embodiment, second embodiment, third embodiment and fourth em- 
bodiment are stored in a robot controller as a "posture alignment mode using single axis' , a "posture alignment mode 
using a coordinate system" . a "mode for setting a coordinate system on a moving part of a tool" and a "suspension 
40 mode dependent on suspension conditions" , respectively. A mode is then selected using the soft key 11 and processing 

for the selected mode is executed. . . 

[0081] The work coordinate system and thatool coordinate system (the reference tool coordinate system referred 
to the "mode for setting a coordinate system on a moving part of a tool" of the third embodiment) are the same for any 
embodiment (any mode). The function selection key 18 Is therefore operated so as to select the coordinate system, 
45 and the work coordinate system and tool coordinate system are collectively set with respect to the four modes for 

assisting the teaching operation. 

[0082] Further, the value set for the speed of the manual operation in this teaching assistance operation can also 
be set beforehand in such a manner as to be common for all modes. Alternatively, when the operating speed is set 
manually at every mode, the soft key 11 can be operated to invoke individual modes for setting, thereby setting the - 
50 operation speed for each mode. 

[0083] In the "mode for setting a coordinate system on a moving part of a tool' of the third embodiment^ the reference 
value O has to be set. but such a set value peculier to each mode can be set after invoking of the individual mode for 
setting. 

55 [Application to a^ervo Gun] . „ . 

[0084] The following is a description of an embodiment where the present invention is applied to a servo gun for 
driving a movable side tip using a servo motor so as tr carry out spot welding. 
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[0085] In this embodiment, the posture of a servo gun 20 is taught so that the opening and closing direction of the 
gun is perpendicular to the surface of workpiece 21 which includes a contact point. Further, the position of contact 
between a fixed side tip 20b and the workpiece 21 is taught. In a typical vehicle spot welding, there are many cases 
where the view of the lower part of a panel is obstructed by the vehicle body, and a descriptbn is given of teaching 
5 operation carried out under such condition by the robot controller according to the present invention. 

[0086] First, as shown in FIG. 1 1 (a), the robot is manually fed and the servo gun 20 is moved In such a manner as 
to come close to a collision point with the workpiece 21 . 

[0087] Next, the posture of the servo gun has to be changed In such a manner that the opening and closing direction 
of the servo gun is perpendicular to surface of the workpiece which includes a collision point. There are three methods 

10 . with which to achieve this. One is to use the "mode for setting a coordinate system on a moving part of a tool" of the 
third embodiment, other is to use the "posture alignment mode using single axis" o1 the first embodiment, and still other 
is to use the "posture alignment mode using a coordinate system" of the second embodiment. 
[0088] In the case of using the "mode for setting a coordinate system pn a moving part of a tool" of the third embod- 
iment, this mode Is selected by the soft key etc. of the teaching pendant 104, and, the movable side tip of the servo 

IS gun is moved so that the TCP comes as close as possible to the workpiece 21, then, the rotation operation key 1 3 is 
selected in such a manner that the opening and closing direction of the gun is perpendicular to the surface of the 
workpiece 21 which includes a collision point. When the shift key 15 and the select rotation operation key 13 are 
pressed, the main processor 101 of the robot controller executes the process .shown in FIG. 7 to cause the robot to 
operate (refer to FIG. 11(b)) taking the TCP set at the end of the movable tip 20a as a reference. 

20 [0089] As a result, the posture of the servo gun 20 can be manually moved in such a manner that the opening and 
closing direction of the servo gun 20 becomes perpendicular to the surface of the workpiece 21 which include a collision 
point without the servo gun 20 and the workpiece 21 interfering with each other. 

[0090] On the other hand, in case of using the "posture alignment mode using single axis" of the first embodiment, 
this mode is selected by the soft key 1 1 . And the angle of intersection 6 of the axes of the tool coordinate system T 

25 and the work coordinate system W for posture alignment is set. In the example of FIG. 11 (c), the Z axes are set from 
the tool coordinate system T and the work coordinate system W as the axes for posture alignment and the angle of 
intersection G is set to "0" (i.e. the 2 axes of both the coordinate systems are made parallel with respect to each other). 
[0091] When the shift key 15 and the posture alignment key 19 are pressed, the main processor 101 of the robot 
controller starts the process shown in FIG. 3, the robot is driven in such a manner as to make the angle of intersection 

30 between the axes Z that are the axes selected for the tool coordinate system T and the work coordinate system W 
become the set angle of intersection G (=0). and position is decided in such a manner that the opening and closing 
direction of the servo gun 20 becomes perpendicular to the surface of the workpiece 21 which includes a collision point 
(refer to FIG. 11(c)). 

[0092] . In case where the " posture alignment mode using a coordinate system' of the second embodiment is selected, 
ss the angle of rotation about each axes of the work coordinate system W defining the relative relationship between the 
tool coordinate system T and the work coordinate system W is set. When the shift key 15 and posture alignment key 
19 are pressed, the processor 101 executes the process shown in FIG. 5 to carry out position such that the opening 
and closing direction of the servo gun 20 becomes perpendicular to the surface of the workpiece 21 which includes a 
collision point, as shown in FIG. 11 (c). 
40 [0093] In the example in FIG. 11 (c). the tool coordinate system T is aligned to the work coordinate system W, with 
- - the result that all the rotation angles about of each axis to be set become 'O' snd the transformation matrix F obtained- 
in step b1 of FIG. 5 becomes a unit matrix. 

[0094] After positioning is carried out so that the opening and closing direction of the servo gun 20 becomes per- 
pendicular to the surface of the workpiece 21 which includes a collision point, the mode is switched to the "suspension 

^ mode dependent on suspension conditions" of the fourth embodiment. Then, the suspension conditions for monitoring 
are selectively set and retreat is not selected. When the shift key 15 is pressed together with the operation key 12 
which causes the fixed side tip to come into contact with the workpiece 21 , the main processor 1 01 of the robot controller 
executes the process of FIG. 10 and suspension takes place automatically at the position where the workpiece 21 and 
the fixed side tip 20b of the tool 20 come into contact (i.e. a position where movement is done in the set direction and 

so by the set amount of movement). 

[Application to an Air Gun] 

[0095] In the case where the spot welding gun is an air gun opening and ctosing using air pressure rather than a 
ss servo gun driven by a servo motor, it is necessary to make thaopjening andclosing^dicection ^ the air gun 20 perpen- . 
.- . dicular. tp thjB syrface_of the wprkpjece 21 v^ich includes a collisiori point and it is necessary to have a gap of a 

designated distance between the fixed side tip 20a and the workpiece 21 . 

[0096] When an air gun 20 is used, as with the aforementioned servo gun. the gun is kept open and nnanualty fed 
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to an appropriate position near the collision point in the workpiece 21 . The "posture alignment mode using a coordinate 
system " of the second embodinnent is selected, the direction of opening and closing of the gun is made perpendicular 
to the surface including a collision point and the "suspension mode dependent on suspension conditions" of the fourth 
embodiment is selected as with the servo gun. However, in this case, as it is necessary to make a prescribed distance 
of separation after the servo gun 20 and the workpiece 21 come into contact, "retreat" is selected and the withdrawal 
direction and extent of evacuation is set. 

[0097] In the example in FIG. 12, the direction of retreat is taken to be the Z axis direction of the work coordinate 
system (or the tool coordinate system) and the target amount of retreat is set. Then, the tool 20 is separated by the 
set distance and the robot is suspended after the workpiece 21 and the tool 20 come into contact, by the processing 
at step d5 and step d6 of FIG. 10. 

[Application to a Servo Hand] 

[0098] FIGS. 1 3(a) to 1 3(c) are views describing an example of the present Invention applied to teaching of a grasping 
position posture to a hand 20 driven by a servo motor 

[0099] First, the hand 20 is manually operated so as to come near to the workpiece 21 with the hand 20 in an open 
state (refer to FIG. 13(a)). Then, the hand has to be rotated in such a manner that the grasping surfaces of the hand 
is parallel to the sides of the workpiece. To attain this, the "posture alignment mode using single axis" of the first 
embodiment, the "posture alignment mode using a coordinate system" of the second embodiment and the "mode for 

setting a coordinate system on a moving part of a tool" of the third embodiment are utilized. 

[0100] FIG. 1 3(b) is a view illustrating the case where the "mode for setting a coordinate system on a moving part 
of a tool" of the third embodiment is utilized. First, the TCP set at the moving part of the hand is moved by a manual 
feeding so as to be moved as close as possible to the workpiece 21 . Then the mode is switched to the "mode for setting 
a coordinate system on a moving part of a tool" , and a rotation directran is selected. When the rotation operatiori 
direction key 13 for this direction and shift key 15 are pressed, the processor 101 for the robot controller carries out 
the process shown in FIG. 7 so that the rotation about the TCP is performed by manual operation, with the result that 
the teaching side surface of the hand 20 becomes parallel to the side surface of the workpiece 21 (refer to FIG. 1 3(b)). 
[0101] FIG; 1 3(c) is a view illustrating the case of using the " posture alignment mode using single axis " of the first 
embodiment or the "posture alignment mode using a coordinate system" of the second embodinnent. 
[0102] In case of using the "posture alignment mode using single axis", an axis (axis Z in FIG. 1 3(c))parallel to the 
grasping surface of the hand 20 in the tool coordinate system T and an axis (axis Z in FIG. 13(c)) parallel to e side 
surface of the workpiece 21 In the work coordinate system W are selected and the angle of intersection is set to "0" , 
for example. When the shift key 15 and posture alignment key 19 are pressed, the main processor 101 carries out the 
process of FIG. 3 so as to operate the robot In such a manner that the teaching side surface of the hand 20 and the 
side surface of the workpiece 21 become parallel. 

[0103] In case of using the "posture alignment mode using a coordinate system" is used, in the example in FIG. 13 
(c), the angle of rotation about each of the axes X, Y and Z of the work coordinate system W is all set to "0" . When 
the shift key 15 and posture alignment key 19 are pressed, the main processor 101 carries out the process of FIG. 5 
and the robot is operated in such a manner that the teaching skie surface of the hand 20 becomes parallel to the side 
surface of the workpiece 21 . 

[0104] In the present inversion, .as the tool posture can be automatically moved to the desired posture by a manual 
operation during teaching, teaching can be carried out without difficulty and with accuracy even for positions where 
the relationship between the tool and the workplace cannot be seen. The tool coordinate system, which hat been set 
at a moving part of a tool, can also be automatically reset in line with movement of the moving parts. Therefore, inter- 
ference between the tool and the workpiece can be avoided even when rotating the tool posture about the tool center 
point (TCP). 

[0105] Further, when suspension conditions are set and these suspension conditions are then fulfilled, accurate 
teaching is possible after automatically interrupting a manual operation. 



Claims 

1. A robot controller comprising: 

storage means for storing a tool coordinate system seUolhe-posilion and,pQsturex)f a tool attached to ajrobiot, 

awork coordinate system set to the envirprnment where a workpiece is placed, any one coordinate axis selected 

from the three coordinate axes of the tool coordinate system and any one coordinate axis selected from the 
three coordinate axes of the work coordinate system used in carrying out posture alignment, and an angle of 
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intersection formed between said two selected coordinate axes; 

means for obtaining a target posture of the robot in a such manner that the angle formed between the two 
selected coordinate axes becomes equal to the stored angle when a posture alignment instruction is inputted; 
and 

means for automatically moving the robot to the target posture. 

A robot controller comprising: 

storage means for storing a tool coordinate system set to the position and posture of a tool attached to a robot, 
a work coordinate system set to the environment where a workpiece is placed, and data specifying a posture 
relationship of the tool coordinate system and the work coordinate system used in carrying out posture align- 
ment; 

means for obtaining a target posture of the robot in such a manner that the tool coordinate system and the 
work coordinate system take on the posture relationship indicated by the specified data stored in the storage 
means when a posture alignment instruction is inputted; and 
means for automatically moving the robot to the target posture. 

The robot controller according to claim 2, wherein the data specifying the posture relationship ot the tool coordinate 
system and the work coordinate system are rotation angles about each coordinate axis which would be necessary 
to make a posture of a virtual coordinate system obtained by. rotating the work coordinate system about each 
coordinate axis of the work coordinate system itself in a virtual manner and in a prescribed order coincide with a 
posture of the tool coordinate system when the robot is moved to the target posture for posture alignment. 

A robot controller, with a tool having moving parts attached to a robot and with a tool coordinate system set to a 
reference position and posture on the moving parts, said robot controller comprising: 

means for transforming the too! coordinate system based on an amount of movement of the moving parts of 
the tool frorh the reference position and posture, 

wherein the tool coordinate system is made to move in line with movement of the moving parts of the tool from 
the reference position and posture. 

A robot controller comprising: 

monitoring means for monitoring whether or not a manual operation suspension condition set in advance in 
' the robot controller is fulfilled, said manual operation suspension condition being fulfilled when a sense signal 
from a sensor for sensing contact ot a tool attached to a robot and a workpiece is outputted, when a load 
torque on one or more motor of motors driving each axis of the robot exceeds a set torque, or when a prede- 
termined distance is moved from a manual operation start position, 

wherein the manual operation is automatically interrupted when futfillment of the suspension conditions is 
detected from the monitoring means during a manual feeding. 

The robot controller according to claim 5, wherein the feed direction by said manual feeding can be selected to 
any one of X, Y and Z axes of the robot reference coordinate system, the work coordinate system or the tool 
coordinate system. 

The robot controller according to claim 5 or claim 6, further comprising means tor storing a robot position when 
said suspension condition is fulfilled, wherein the robot, which has moved a distance due to its inertia from the 
fulfillment of the suspension condition to actual stop, is relumed to the position stored in the storage means. 

The robot controller according to claim 7, further comprising means for setting and storing for a direction and a 
distance of retreat from a position.where the suspension condition is fulfilled, wherein the robot moves a set distance 
in a direction stored in the storage means after suspension at a position where the suspension condition Is fulfilled. 
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(54) Robot controller 

(57) Axes used for posture alignment are selected 
from the axes of a work coordinate system W and a tool 
coordinate system T, and an angle of intersection be- 
tween those selected axes are set. A robot is then driven 
so that the selected axes intersect with each other by 
the set angle of intersection in response to a posture 
alignment Instruction, causing the tool to assume a tar- 
get.posture with respect to a wbrkpiece. Further, angles 
for rotating the work coordinate system about each axis 
thereof are set, then the robot is automatically moved 
so that a coordinate system produced by rotating the 
work coordinate system by the set angle in response to 
a posture alignment instruction. Further, the tool coordi- 
nate system set at a movable part of a tool is automat- 
ically reset according to an amount of movement every 
time the movable part of the tool move, and the robot is 
manually fed based on the tool coordinate system thus 
reset. 
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